﻿using System;
using System.IO.Ports;
using Microsoft.SPOT;
using Microsoft.SPOT.Input;
using Microsoft.SPOT.Presentation;
using Microsoft.SPOT.Presentation.Controls;
using Microsoft.SPOT.Hardware;
using Microsoft.SPOT.Presentation.Media;
using Microsoft.SPOT.Presentation.Shapes;
using GHIElectronics.NETMF.Hardware;

namespace GadgeteerBee
{
    //public class MainWindow : Window
    public partial class Program
    {
        //SerialPort serialPort;
        Gadgeteer.Interfaces.Serial serial;
        System.Threading.Thread serialPortThread;

        enum PacketType
        {
            Radio = 0x01,
            Response = 0x02,
            RadioSubTel = 0x03,
            Event = 0x04,
            CommonCommand = 0x05,
            SmartAckCommand = 0x06,
            RmoteManCommand = 0x07
        };

        void InitializeSerialPort()
        {
            xBee.Configure(57600,
                Gadgeteer.Interfaces.Serial.SerialParity.None,
                Gadgeteer.Interfaces.Serial.SerialStopBits.One,
                8);
 
            serial = xBee.SerialLine;
            serial.ReadTimeout = -1; //SerialPort.InfiniteTimeout
            serial.Open();
            serialPortThread = new System.Threading.Thread(SerialPortThread);
            serialPortThread.Start();
        }

        void RightRectangleOn()
        {
            sg.DisplayRectangle(Colors.Green, thickness, Colors.Green, 0, y, width - offset, height);
            led.TurnGreen();
        }

        void RightRectangleOff()
        {
            sg.DisplayRectangle(Colors.Green, thickness, Colors.Black, 0, y, width - offset, height);
            led.TurnOff();
        }

        void LeftRectangleOn()
        {
            sg.DisplayRectangle(Colors.Red, thickness, Colors.Red, width + offset, y, width - offset, height);
            led1.TurnRed();
        }

        void LeftRectangleOff()
        {
            sg.DisplayRectangle(Colors.Red, thickness, Colors.Black, width + offset, y, width - offset, height);
            led1.TurnOff();
        }

        void SerialPortThread()
        {
            byte[] readBuffer = new byte[32];
            bool gotHeader;
            int porg = 0;
            int[] data = new int[4];
            int id;
            int nu = 0;

            int dataLength;
            int dataSize = 4;

            byte optionalLength;
            PacketType packetType;
            byte crc8h;
            byte crc8d;

            while (true)
            {
                byte[] header = new byte[4];
                gotHeader = false;
                do
                {
                    do
                    {
                        serial.Read(readBuffer, 0, 1);
                    }
                    while (readBuffer[0] != 0x55);

                    serial.Read(header, 0, 4);

                    dataLength = header[0] << 8 | header[1];
                    optionalLength = header[2];
                    packetType = (PacketType) header[3];

                    serial.Read(readBuffer, 0, 1);
                    crc8h = readBuffer[0];

                    gotHeader = crc8h == crc.crc8(header);
                }
                while (!gotHeader);

                for (int i = 0; i < dataLength; i++)
                {
                    serial.Read(readBuffer, i, 1);
                    //checksum += readBuffer[i];
                }

                if (packetType == PacketType.Radio)
                {
                    porg = readBuffer[0];
                    if (porg == 0xF6 || porg == 0xD5)
                    {
                        dataSize = 1;
                        nu = (readBuffer[dataSize + 5] >> 4) & 0x01;
                        data[0] = readBuffer[1] >> 4;
                        data[1] = readBuffer[1] & 0x0F;
                    }
                    else
                    {
                        //dataSize = 4;
                        data[0] = readBuffer[1];
                        data[1] = readBuffer[2];
                        data[2] = readBuffer[3];
                        data[3] = readBuffer[4];
                    }
                }

                id = (readBuffer[dataSize + 1] << 24)
                    | (readBuffer[dataSize + 2] << 16)
                    | (readBuffer[dataSize + 3] << 8)
                    | readBuffer[dataSize + 4];

                if (optionalLength > 0)
                {
                    serial.Read(readBuffer, dataLength, optionalLength);
                }

                serial.Read(readBuffer, dataLength + optionalLength, 1);
                crc8d = readBuffer[dataLength + optionalLength];

                if (crc8d == crc.crc8(readBuffer, dataLength + optionalLength))
                {
                    if (porg == 0xF6 && nu == 0x01)
                    {
                        for (int i = 0; i < 2; i++)
                        {
                            switch (data[i])
                            {
                                case 0x05:
                                    Dispatcher.BeginInvoke(
                                        new DispatcherOperationCallback(
                                            delegate (object o)
                                            {
                                                RightRectangleOn();
                                                return null;  
                                            }
                                            ), null);
                                    break;
                                case 0x07:
                                    Dispatcher.BeginInvoke(
                                        new DispatcherOperationCallback(
                                            delegate (object o)
                                            {
                                                RightRectangleOff();
                                                return null;  
                                            }
                                            ), null);
                                    break;
                                case 0x01:
                                    Dispatcher.BeginInvoke(
                                        new DispatcherOperationCallback(
                                            delegate (object o)
                                            {
                                                LeftRectangleOn();
                                                return null;  
                                            }
                                            ), null);
                                    break;
                                case 0x03:
                                    Dispatcher.BeginInvoke(
                                        new DispatcherOperationCallback(
                                            delegate (object o)
                                            {
                                                LeftRectangleOff();
                                                return null;  
                                            }
                                            ), null);
                                    break;
                            }
                        } // for
                    }// if
                    else if (porg == 0xA5) // 4BS, sensors
                    {
                        // sensor data...
                        uint inputValue = (uint)data[2];

                        if (true /* id == 0x0081851B */ )
                        {
                            // should be POTI
                            double value = inputValue * 100 / 255;
                            string text = value.ToString("F1") + " %";

                            Dispatcher.BeginInvoke(
                                new DispatcherOperationCallback(DisplayPoti),
                                text);
                        }
                        if (true)
                        {
                            // Temperature sensor
                            const double temperatureCalibration = 65.77D;
                            const double temperatureInclination = -0.3455D;
                            double value = temperatureInclination * inputValue + temperatureCalibration;
                            string text = value.ToString("F1") + "\u00B0C";

                            Dispatcher.BeginInvoke(
                                new DispatcherOperationCallback(DisplayTemperature),
                                text);
                        }
                    }
                }
            }
        }
    }

    public static class crc
    {
        private static Byte[] crc8Table = new Byte[]
        {
            0x00, 0x07, 0x0e, 0x09, 0x1c, 0x1b, 0x12, 0x15,
            0x38, 0x3f, 0x36, 0x31, 0x24, 0x23, 0x2a, 0x2d,
            0x70, 0x77, 0x7e, 0x79, 0x6c, 0x6b, 0x62, 0x65,
            0x48, 0x4f, 0x46, 0x41, 0x54, 0x53, 0x5a, 0x5d,
            0xe0, 0xe7, 0xee, 0xe9, 0xfc, 0xfb, 0xf2, 0xf5,
            0xd8, 0xdf, 0xd6, 0xd1, 0xc4, 0xc3, 0xca, 0xcd,
            0x90, 0x97, 0x9e, 0x99, 0x8c, 0x8b, 0x82, 0x85,
            0xa8, 0xaf, 0xa6, 0xa1, 0xb4, 0xb3, 0xba, 0xbd,
            0xc7, 0xc0, 0xc9, 0xce, 0xdb, 0xdc, 0xd5, 0xd2,
            0xff, 0xf8, 0xf1, 0xf6, 0xe3, 0xe4, 0xed, 0xea,
            0xb7, 0xb0, 0xb9, 0xbe, 0xab, 0xac, 0xa5, 0xa2,
            0x8f, 0x88, 0x81, 0x86, 0x93, 0x94, 0x9d, 0x9a,
            0x27, 0x20, 0x29, 0x2e, 0x3b, 0x3c, 0x35, 0x32,
            0x1f, 0x18, 0x11, 0x16, 0x03, 0x04, 0x0d, 0x0a,
            0x57, 0x50, 0x59, 0x5e, 0x4b, 0x4c, 0x45, 0x42,
            0x6f, 0x68, 0x61, 0x66, 0x73, 0x74, 0x7d, 0x7a,
            0x89, 0x8e, 0x87, 0x80, 0x95, 0x92, 0x9b, 0x9c,
            0xb1, 0xb6, 0xbf, 0xb8, 0xad, 0xaa, 0xa3, 0xa4,
            0xf9, 0xfe, 0xf7, 0xf0, 0xe5, 0xe2, 0xeb, 0xec,
            0xc1, 0xc6, 0xcf, 0xc8, 0xdd, 0xda, 0xd3, 0xd4,
            0x69, 0x6e, 0x67, 0x60, 0x75, 0x72, 0x7b, 0x7c,
            0x51, 0x56, 0x5f, 0x58, 0x4d, 0x4a, 0x43, 0x44,
            0x19, 0x1e, 0x17, 0x10, 0x05, 0x02, 0x0b, 0x0c,
            0x21, 0x26, 0x2f, 0x28, 0x3d, 0x3a, 0x33, 0x34,
            0x4e, 0x49, 0x40, 0x47, 0x52, 0x55, 0x5c, 0x5b,
            0x76, 0x71, 0x78, 0x7f, 0x6A, 0x6d, 0x64, 0x63,
            0x3e, 0x39, 0x30, 0x37, 0x22, 0x25, 0x2c, 0x2b,
            0x06, 0x01, 0x08, 0x0f, 0x1a, 0x1d, 0x14, 0x13,
            0xae, 0xa9, 0xa0, 0xa7, 0xb2, 0xb5, 0xbc, 0xbb,
            0x96, 0x91, 0x98, 0x9f, 0x8a, 0x8D, 0x84, 0x83,
            0xde, 0xd9, 0xd0, 0xd7, 0xc2, 0xc5, 0xcc, 0xcb,
            0xe6, 0xe1, 0xe8, 0xef, 0xfa, 0xfd, 0xf4, 0xf3
        };

        public static Byte crc8(Byte[] data)
        {
            Byte crc = 0;
            for (int i = 0; i < data.Length; i++)
                crc = crc8Table[crc ^ data[i]];
            return crc;
        }

        public static Byte crc8(Byte[] data, int count)
        {
            Byte crc = 0;
            for (int i = 0; i < count; i++)
                crc = crc8Table[crc ^ data[i]];
            return crc;
        }
    }
}
